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ABSTRACT 


In  support  of  TNT  experiments,  the  NPS  UAV  laboratory  has  developed  a  Vision- 
Based  Target  Tracking  (VBTT)  system  for  a  Small  Unmanned  Aerial  Vehicle  (SUAV). 
This  system  provides  an  autonomous  target  tracking  capability,  while  simultaneously 
estimating  the  target’s  velocity  and  position.  The  accuracy  of  the  existing  system  can  be 
improved  by  providing  external  corrections  to  the  target  position  estimation  from  the  geo- 
rectification  system  (GIS).  This  thesis  addresses  the  implementation  of  an  asynchronous 
correction  scheme  into  the  target  position  estimation  filter.  The  current  autonomous 
position  estimation  algorithm  provides  20-30  meters  accuracy.  The  external  correction 
system  (Perspective  View  Nascent  Technologies  (PVNT))  is  expected  to  provide  target 
position  accuracy  of  1-2  m.  However,  a  delay  of  up  to  10  seconds  is  expected.  Therefore, 
in  order  to  improve  the  accuracy  of  current  estimation  of  target  motion,  a  new 
asynchronous  correction  technique  that  incorporates  the  more  accurate  PVNT  data  is 
proposed.  To  further  improve  the  target  motion  estimation,  it  was  also  proposed  to 
incorporate  a  known  road  model  into  the  filter  and  compare  its  performance  with  the 
original  filter. 
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I.  INTRODUCTION 


A.  OVERVIEW 

The  main  goal  of  this  thesis  was  to  design  a  new  filter  that  is  able  to  provide  a 
better  estimation  of  target  motion.  This  new  filter  would  complement  the  current  non¬ 
linear  target  motion  estimation  filter  mounted  on  a  Small  Unmanned  Aerial  Vehicle 
(SUAV).  Naval  Postgraduate  School  (NPS)  is  a  participant  in  the  Tactical  Network 
Topology  (TNT)  field  experimentation  program,  which  includes  United  States  Special 
Operations  Command  (USSOCOM),  its  component  commands  and  several  government 
laboratories.  The  field  experimentations  are  part  of  the  Surveillance  and  Target 
Acquisition  (STAN)  program.  Quarterly  field  experiments  are  conducted  at  the  Center  for 
Inter-disciplinary  Remotely-Piloted  Aircraft  Studies  (CIRPAS)  facility  located  at 
McMillan  Field  in  Camp  Roberts,  California.  These  experiments  aim  to  explore  and 
demonstrate  new  technologies  that  are  applicable  to  the  military,  with  special  focus  on 
sensor  and  wireless  network,  autonomous  vehicle  and  target  tracking/identification. 

B.  MOTIVATION 

The  NPS  SUAV  is  designed  with  Commercial  Off-the-Shelf  sensors  that  reduced 
the  cost  of  operating  the  SUAV.  The  main  role  of  the  SUAV  is  in  the  surveillance  and 
reconnaissance  arena. 

The  utilization  of  Vision-Based  Target  Tracking  (VBTT)  allows  a  passive  mode 
of  target  tracking  and  reduces  the  risk  of  exposure  of  the  UAV  when  it  conducts  its 
surveillance.  This  would  enhance  the  security  of  the  SUAV  operation. 

Currently,  the  VBTT  system  utilizes  a  filter  to  estimate  the  position  of  the  target. 
A  coordinated  control  strategy  is  employed  that  estimates  the  position  of  the  target  using 
the  turn  rate  of  the  Line-of-Sight  (LOS)  between  the  UAV  and  the  target. 

The  accuracy  of  the  estimated  target  motion  can  be  improved  if  an  external 
correction  is  made  to  the  estimated  target  position  obtained  from  the  current  filter.  One 
of  the  possible  correction  methods  can  be  obtained  from  the  Perspective  View  Nascent 
Technologies  (PVNT).  This  technology  will  be  described  in  more  details  in  Chapter  2. 
The  PVNT  software  is  able  to  provide  a  correction  to  the  estimated  target  position  up  to  1 
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meter  accuracy.  However,  this  updated  target  position  would  only  be  made  available 
about  1  to  10  seconds  later.  Thus,  there  is  a  need  to  develop  an  asynchronous  filter  to 
incorporate  this  updated  position. 

To  further  improve  the  performance  of  the  new  asynchronous  filter,  it  is  also 
proposed  that  a  known  road  model  be  incorporated  into  the  filter.  The  performance  of 
this  road-following  asynchronous  filter  will  be  compared  to  the  original  filter  to 
determine  the  anticipated  improvement  that  may  be  achieved. 
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II.  BACKGROUND 


A.  PERSPECTIVE  VIEW  NASCENT  TECHNOLOGIES  (PVNT) 

The  PVNT  system  was  developed  by  Dr.  Wolfgang  Baer,  a  professor  at  the  Naval 
Postgraduate  School  (NPS)  in  Monterey,  California.  The  initial  PVNT  software  was 
designed  for  tactical  weapon  testing.  The  software  provided  a  3D  battlefield  simulation 
and  allowed  the  UAV  to  carry  out  target  locating  functions.  The  use  of  low-cost  PC- 
based  software  helped  to  reduce  the  overall  cost  of  the  system.  Currently,  the  PVNT 
software  is  capable  of  generating  1 -meter-resolution  terrain  data  for  large  area  tactical 
battlefield  simulations  and  uses  it  to  create  perspective  views.  These  perspective  views 
are  employed  to  perform  both  line-of-sight  (LOS)  and  weapon  effectiveness  analysis.  At 
present,  PVNT  databases  cover  locations  such  as  Fort  Hunter  Liggett,  California  and 
Camp  Roberts,  California. 

One  of  the  more  unique  features  of  the  PVNT  program  is  the  use  of  raster  fonnats 
(pixel)  as  storage  for  terrain  surface,  as  opposed  to  polygon  database  that  is  used  by  most 
scene -visualization  programs  on  the  market.  This  makes  PVNT  more  suitable  for 
handling  data  that  is  gathered  by  remote  sensors,  and  ideal  for  integration  with  tactical 
battlefield  sensor  systems. 

Various  experiments  had  previously  been  conducted  at  Camp  Roberts 
incorporating  flight  test  set-up  with  PVNT  work  stations.  The  flight  test  set-up  utilized 
the  vision-based  target  tracking  and  estimation  system  for  both  stationary  and  moving 
targets.  A  generic  set  up  is  shown  in  Figure  1  below. 
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Figure  1.  Flight  set-up  and  PVNT  workstation  [After:  Ref  1]. 


During  flight  tests,  images  captured  by  the  onboard  camera  mounted  on  the 
SUAV  were  broadcast  and  processed  by  OTS  PerceptiVU  image  processing  software 
[Ref  2].  Non-linear  filtering  algorithms  (Figure  2)  developed  at  NPS  estimated  the  target 
geo-location’s  accuracy  to  about  10-20  m  with  10-20  seconds  of  tracking.  Working  in 
parallel,  the  images  captured  from  the  SUAV  and  the  estimated  position  of  the  target 
obtained  from  the  filtering  are  shared  over  the  network  and  fed  to  the  PVNT  vision-based 
target  tracking  system. 

The  PVNT  software  compared  the  images  received  from  the  SUAV,  together  with 
GPS  and  camera  angle  coordinates,  with  the  database  information.  The  accuracy  of  the 
target  position  is  determined  almost  solely  by  the  accuracy  of  the  database  (currently  at  1 
m  resolution).  Thus,  using  the  PVNT-image  mensuration  system  would  yield  the  target 
position  estimates  to  within  1-2  m.  However,  due  to  the  processing  time  required  in 
comparing  the  target  images  with  the  PVNT  database,  there  would  be  a  time  lapse 
(currently  about  1  to  10  seconds)  between  the  time  the  image  of  the  target  is  fed  to  the 
PVNT  system  and  the  updated  position  of  the  target  obtained  from  the  PVNT  system. 

B.  GENERIC  ASYCHRONOUS  KALMAN  FILTER 

In  motion  tracking,  the  standard  Kalman  filter  has  been  extensively  employed. 
However,  such  a  filter  requires  synchronous  and  equi-distant  measurement  updates  to 
ensure  robust  and  accurate  prediction.  In  many  applications,  such  updates  may  not  be 
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practical  or  even  possible.  Many  enhancements  to  the  standard  Kalman  filters  were  made 
[Ref  5,  6]  to  accept  out-of-sequence,  sporadic  or  infrequent  updates  to  the  filter.  Such 
filters  are  typically  known  as  asynchronous  filters. 

Asynchronous  Kalman  filters  have  been  used  in  various  applications.  One  of  the 
more  common  applications  is  in  sensor  fusion.  In  sensor  fusion  applications,  standard 
and  extended  Kalman  filters  are  popular  due  to  the  ease  of  blending  the  various  sensors’ 
data  to  provide  an  optimal  estimate.  Sensors  measuring  target’s  velocity  and/or 
accelerations  can  be  blended  with  sensors  measuring  its  direct  position  to  give  an  optimal 
estimate  of  the  target.  However,  Kalman  filters  require  specific  and  consistent 
information  for  their  current  iteration  in  providing  accurate  prediction  of  the  future  states. 
Any  interruption  in  any  sensors  update  rate  would  degrade  the  effectiveness  of  a  simple 
Kalman  filter.  Thus,  asynchronous  filters  are  designed  to  ensure  that  the  effectiveness  of 
the  Kalman  filters  is  not  degraded  with  asynchronous  updates  from  the  sensors. 

The  implementation  of  the  asynchronous  Kalman  filter  can  also  take  various 
forms.  In  the  paper  “Adaptable  Sensor  Fusion  Using  Multiple  Kalman  Filters”  [Ref  7], 
the  authors  proposed  the  use  of  multiple  Kalman  filters  to  allow  asynchronous  inputs 
from  sensors.  The  central  idea  of  the  paper  is  the  use  of  a  bank  of  Kalman  filters  to 
represent  the  various  combinations  of  sensors.  As  the  data  acquisition  rate  differs  on  the 
various  sensors,  a  sensor  fusion  algorithm  allows  the  selection  of  the  appropriate  model 
to  account  for  the  new  data  that  is  available  at  each  iteration.  Such  switching  alleviates 
the  need  to  receive  infonnation  from  all  sensors  at  every  iteration. 

In  this  thesis,  an  asynchronous  filter  is  developed  to  incorporate  the  delayed  but 
more  accurate  target  position  estimates  from  PVNT. 
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III.  PROBLEM  DEFINITION 


A.  CURRENT  ARCHITECTURE 


Figure  2.  Current  architecture 


Figure  2  depicts  the  current  architecture  for  target  tracking  using  SUAV  in  NPS. 
A  system  to  track  a  target  and  estimate  both  its  velocity  and  position  has  been  in 
development  over  the  years  in  NPS.  Constant  improvements  have  been  made  to  the 
initial  concept  of  target  tracking.  The  current  control  system  uses  a  nonlinear  filter  for 
target  estimation  [Ref  8].  This  filter  has  shown  stability  in  motion  target  estimation  and 
graceful  degradation  of  perfonnance  during  target  loss  events.  The  filter  has  been  flight 
tested  using  a  moving  target  and  is  capable  of  estimating  target  position  to  an  accuracy  of 
20  meters.  Both  the  target’s  velocity  and  position  estimations  are  available  in  real  time. 

In  parallel,  the  target  image  captured  by  the  onboard  camera  of  the  small  UAV  is 
sent  to  the  PVNT  system  as  described  in  Chapter  II.  From  PVNT,  the  target  position 
estimation  is  expected  to  be  1-2  meters  but  with  a  delay  of  up  to  10  seconds. 
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B.  PROBLEM  DEFINITION 


In  the  diagram  above,  a  target  is  traveling  along  a  simulated  road.  At  time  r  ,  the 
captured  image  of  the  target  is  sent  to  PVNT  for  processing.  At  the  same  time,  the 
nonlinear  filter  onboard  the  UAV  is  processing  the  target  image  and  estimating  the 
position  of  the  target.  At  time  t  (t  >  r  ),  when  the  target  has  traveled  a  finite  distance 
along  the  road,  an  updated  target  position  for  time  r  arrived  from  PVNT.  The  present 
filter  would  not  be  able  to  use  this  information  to  provide  a  better  estimation  of  the 
target’s  position  and  velocity. 

C.  OBJECTIVES 

To  provide  a  better  target  motion  estimation  using  the  more  accurate  but  delayed 
PVNT  position  update,  a  new  filter  would  be  designed.  This  filter  would  be  able  to  use 
the  PVNT  position  and  provide  a  more  accurate  velocity  and  position  update  at  time  t. 
To  further  enhance  the  filter,  this  thesis  would  also  examine  the  performance  of  the  filter 
that  incorporates  the  road  profile  that  the  target  is  traveling  on. 
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IV.  FILTER  DEVELOPMENT 


A.  GENERAL  ASYNCHRONOUS  FILTER 

The  following  diagram  shows  the  design  of  the  new  general  asynchronous  filter 
that  was  developed  to  estimate  target  motion  (both  velocity  and  position)  using  delayed 
PVNT  target  position  estimation. 
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T rue  target  model 
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PVNT  update 

Data  storage 

Open-loop  filter 


Figure  4.  General  asynchronous  filter 


1.  True  Target  Vehicle  Model 

A  true  target  vehicle  model  was  created  in  Simulink.  It  served  two  purposes.  The 
first  purpose  was  to  generate  the  target’s  velocity  and  position  vectors  in  Local  Tangent 
Plane.  Generated  positions  of  the  target  were  fed  to  the  PVNT  model  to  provide  delayed 
position  of  the  target.  The  second  purpose  was  to  compare  the  target’s  actual  velocity 
and  position  with  the  filter’s  estimates.  The  Simulink  model  of  the  true  vehicle  model  is 
shown  below. 
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T  gtP_true  (xyz) 

Figure  5.  True  target  vehicle  model 


2.  PVNT  Model 

The  purpose  of  the  PVNT  model  was  to  simulate  the  delayed  data  received  from 
the  PVNT  software.  In  Simulink,  the  PVNT  model  received  position  data  from  the  true 
vehicle  model,  and  using  a  Matlab  script  fde  generated  delayed  target  position  based  on 
the  delay  timing  specified  by  the  user.  PVNT  noise  can  also  be  added  to  the  generated 
target  position.  A  Simulink  diagram  of  the  PVNT  model  is  shown  below. 


Figure  6.  PVNT  model 

3.  Data  Storage 

In  the  model,  a  data  storage  model  is  generated  to  store  the  target’s  velocity  and 
position  data.  Both  the  true  and  estimated  velocity  and  position  are  stored.  This  data  is 
marked  with  a  time  stamp  that  allows  it  to  be  retrieved  based  on  the  time  lapse  between 
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the  current  time  and  the  delayed  time  of  the  PVNT  update.  The  filter  has  been  designed 
to  cater  for  varying  delay  times. 

4.  Filter 

The  Simulink  model  of  the  filter  that  was  designed  is  shown  below. 


Figure  7.  Simulink  model  of  filter  in  general  asynchronous  filter 

This  filter  uses  dead-reckoning  when  there  is  no  PVNT  update.  It  is  initiated 
based  on  the  initial  estimate  of  the  target’s  velocity  and  position.  The  gains  (K1  and  K2) 
are  fixed.  When  the  delayed  PVNT  update  arrives  (at  time  t  for  data  at  time  r  ),  the  filter 
integrates  backward  and  forward  in  time  (from  time  z  to  t)  using  PVNT  delayed  data. 
The  output  from  the  filter  is  an  updated  target  velocity  and  position  at  time  t.  Both  the 
velocity  and  position  data  at  time  t  are  used  to  re-initialize  the  open-looped  filter  to 
provide  the  target’s  velocity  and  position  from  time  t. 

B.  ROAD  FOLLOWING  ASYNCHRONOUS  FILTER 

The  road  following  asynchronous  filter  was  developed  from  the  general 
asynchronous  filter  with  some  modifications.  The  diagram  shows  the  Simulink 
representation  of  the  road  following  asynchronous  filter.  The  main  difference  for  the 
road  following  asynchronous  filter  is  the  use  of  a  parameter,  p  (path  length  of  the  road), 
to  characterize  the  road  that  the  target  vehicle  is  moving  on.  This  parameter  is  chosen 
because  its  derivative,  p ,  is  the  speed  of  the  vehicle  at  any  point  on  the  road.  The 
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differences  in  the  various  models  within  the  general  asynchronous  filter  and  the  road 
following  asynchronous  filter  are  highlighted  in  the  next  few  paragraphs. 


Figure  8.  Road  following  asynchronous  filter 


1.  True  Target  Vehicle  Model  with  Road  Following  Characteristics 

The  following  diagram  is  the  modified  true  target  vehicle  model. 


Data  storage 


Figure  9.  True  vehicle  model  with  road  following  characteristics 
The  main  difference  with  the  true  vehicle  model  in  the  road  following 
asynchronous  filter  is  the  use  of  the  path  length  parameter  to  characterize  the  road.  The 
values  of  the  generated  true  path  length  as  well  as  the  speed  of  the  vehicle  are  stored  to  be 
used  when  the  PVNT  position  update  arrives. 
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2.  PVNT  Model 

The  PVNT  model  for  the  road  following  asynchronous  filter  is  the  same  as  the 
one  used  for  general  asynchronous  filter. 

3.  Filter 

The  asynchronous  filter  used  in  this  section  is  shown  in  Figure  10.  Both  the 
inputs  and  outputs  of  this  filter  (shown  below)  are  scalar  (path  length  and  speed). 


Figure  10.  Simulink  model  of  filter  in  road  following  asynchronous  filter 

4.  Optimization 

An  optimization  routine  is  implemented  with  the  road  following  asynchronous 
filter  to  determine  the  path  length  parameter,  p  .  The  minimization  equation  is  as  shown. 

min  (x(p)-xPVNT)2 +(y(p)-yPVNT)2 +(z(p)-zPVNT)2  (1) 
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V.  SIMULATION 


A.  FRAME  REFERENCE 

The  frame  reference  used  during  the  simulation  is  the  Local  Tangent  Plane  (LTP). 

B.  DURATION 

The  simulation  duration  is  set  at  180  seconds. 

C.  SAMPLE  TIME 

The  sample  timing  used  during  the  simulation  is  fixed  at  0.1  second  rate.  For  a 
simulation  of  180  seconds,  this  equates  to  1800  data  points. 

D.  ROAD  MODEL 

In  the  simulation,  the  following  equations  are  used  to  model  the  road. 


x{p) 

p 

p  = 

road 

yip ) 

= 

0.0000192/?3  -0.025/r  +9.74/? 

Ap)_ 

0 

A  cubic  representation  of  the  road  was  chosen  for  the  simulation  to  ensure  that  the 
profile  chosen  would  not  be  a  monotonically  increasing  function  of  the  path  length.  The 
road  profile  in  x-y  representation  is  v  =  0.0000192x3 -0.025x2 +9.74x  and  a  visual 
representation  of  this  road  profile  is  shown  in  Figure  11. 
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Figure  1 1 .  Simulated  road  profde 


E.  MEASURE  OF  PERFORMANCE  (MOP) 

Since  the  main  purpose  of  both  filters  is  estimation  of  the  motion  of  the  target 
vehicle,  the  MOP  chosen  was  the  root-mean-square  (rms)  errors  between  the  true  motion 
and  estimated  motion. 


rms  error  _  velocity  = 


(3) 


rms  error 


position  = 


(4) 


F.  FILTER  COMPARISON 


The  performance  of  the  general  asynchronous  filter  and  the  road  following 
asynchronous  filter  were  compared  by  varying  some  of  the  filter  parameters.  The 
variables  include: 

1.  K1  and  K2  Gains 

The  fixed  gains  within  the  filter  are  varied  from  a  value  of  10  down  to  0.1.  The 
rms  errors  in  both  velocity  and  position  were  compared. 
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2.  PVNT  Delay 

The  expected  delay  from  PVNT  was  randomized  with  increasing  magnitude  (from 
1  to  10  seconds).  The  nns  errors  in  both  velocity  and  position  were  again  compared. 

3.  PVNT  Noise 

Lastly,  the  PVNT  noise  (errors  that  can  be  expected  from  the  PVNT  software)  is 
also  varied  within  each  filter.  The  noise  added  to  the  PVNT  position  ranged  from  +/-  1 
meter  to  5  meters.  Similarly,  the  rms  errors  in  both  velocity  and  position  were  compared. 
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VI.  RESULTS  AND  ANALYSIS 


A.  FILTER  PERFORMANCE  WITH  K1  AND  K2  VALUES 

To  examine  the  filter  performance  based  on  variation  of  K1  and  K2  values,  the 
other  two  parameters  were  fixed.  The  PVNT  delay  is  random  but  does  not  exceed  1 
second  while  the  PVNT  noise  is  set  at  +/-  0  meter  (i.e.  no  noise).  The  K1  and  K2  gains 
are  fixed  at  the  following  values  shown  in  the  table  below. 


Table  1.  Variation  of  K1  and  K2 


Runs  conducted 

K1 

K2 

Run  1 

10 

10 

Run  2 

5 

5 

Run  3 

1 

1 

Run  4 

0.5 

0.5 

Run  5 

0.1 

0.1 

1.  Results 

The  following  four  plots  show  the  results  obtained  for  both  the  general  and  road 
following  asynchronous  filters  for  the  rms  errors  obtained  for  the  target’s  velocity  and 
position. 


Plot  of  target's  velocity  rms  error  vs  K1/K2  values 
(General  asynchronous  filter) 


□  rms  error 


Figure  12.  Target  velocity  rms  errors  vs  K1/K2  values  (general  asynchronous  filter) 
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Figure  13. 


Figure  14. 


Plot  of  target's  position  rms  error  vs  K1/K2  values 
(General  asynchronous  filter) 
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Target  position  rms  errors  vs  K1/K2  values  (general  asynchronous  filter) 
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Plot  of  target's  velocity  rms  error  vs  K1/K2  values 
(Road  following  asynchronous  filter) 

0.016079 


0016056 

0.016035 

0.01 6032  0  016029 

10 

10 


1 
1 

K1  /  K2  values 


0.5 

0.5 


0.1 

0.1 


□  rms  error 


Target  velocity  rms  errors  vs  K1/K2  values  (road  following  asynchronous 

filter) 
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Plot  of  target's  position  rms  error  vs  K1/K2  values 
(Road  following  asynchronous  filter) 
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Figure  15.  Target  position  rms  errors  vs  K1/K2  values  (road  following  asynchronous 

filter) 


2.  Analysis 

For  both  filters,  decreasing  the  gains  from  10  to  0.1  resulted  in  a  decrease  in  the 
rms  errors  for  both  velocity  and  position  estimations.  In  both  filters,  the  gains  K1  and  K2 
were  activated  only  when  there  was  a  PVNT  update.  For  the  simulation,  this  equates  to 
about  10%  (180  PVNT  updates  over  1800  data  points)  of  the  simulation  time.  As  such, 
although  a  smaller  gain  is  desired,  the  rms  errors  resultig  from  the  different  gains  did  not 
differ  significantly. 

B.  FILTER  PERFORMANCE  WITH  PVNT  DELAY 

To  examine  the  filter  performance  based  on  PVNT  delays,  the  other  two 
parameters  were  fixed.  The  K1  and  K2  values  are  fixed  at  0.5  while  the  PVNT  noise  was 
set  at  +/-  0  meter  (i.e.  no  noise).  The  PVNT  delays  are  random,  but  cannot  exceed  the 
values  shown  in  Table  2. 
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Table  2.  Variation  of  PVNT  delays 


Runs  conducted 

PVNT  delays  (seconds) 

Run  1 

1 

Run  2 

2 

Run  3 

3 

Run  4 

5 

Run  5 

10 

1.  Results 

The  following  four  plots  show  the  results  obtained  for  both  the  general  and  road 
following  asynchronous  filters  for  the  rms  errors  obtained  for  the  target’s  velocity  and 
positions. 


Figure  16.  Target  velocity  rms  errors  vs  PVNT  delay  (general  asynchronous  filter) 
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Figure  17. 


Figure  18. 


Plot  of  position  rms  error  vs  PVNT  delay  (K1  =  0.5,  K2  =  0.5) 
(General  asynchronous  filter) 


— rms  error 


Target  position  rms  errors  vs  PVNT  delay  (general  asynchronous  filter) 


filter) 
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Figure  19.  Target  position  rms  errors  vs  PVNT  delay  (road  following  asynchronous 

filter) 

2.  Analysis 

From  the  plots  above,  the  rms  error  for  both  the  velocity  and  position  increased 
significantly  as  the  PVNT  delay  time  rose.  For  the  general  asynchronous  filter,  the  rms 
error  for  the  estimation  of  target  position  rose  from  10.7722  m  (random  delay  up  to  1 
second)  to  71.9274  m  (random  delay  up  to  10  seconds).  This  was  almost  a  seven-fold 
increase.  The  number  of  PVNT  updates  for  random  delay  up  to  10  seconds  is  expected  to 
be  lower  than  the  number  of  PVNT  updates  for  random  delay  up  to  1  second.  As  such, 
the  general  asynchronous  filter  would  rely  more  on  dead  reckoning  for  random  delay  up 
to  10  seconds,  which  resulted  in  the  significant  increase  in  errors  both  in  the  position  and 
velocity  estimation.  Even  for  the  road  following  asynchronous  filter,  both  the  velocity 
and  position  estimation  showed  an  increasing  trend.  The  optimization  routine,  though 
able  to  reduce  the  magnitude  of  the  velocity  and  position’s  rms  error  significantly  as 
compared  to  the  general  asynchronous  filter,  was  unable  to  prevent  the  increased  in  rms 
error  from  increasing  as  the  PVNT  delay  increased. 
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C.  FILTER  PERFORMANCE  WITH  PVNT  NOISE 

To  examine  the  filter  performance  based  on  PVNT  noise,  the  other  two 
parameters  were  fixed.  The  K1  and  K 2  values  were  fixed  at  0.5  while  the  PVNT  delay 
was  random  but  did  not  exceed  1  meter.  The  PVNT  noise  was  fixed  at  the  following 
values  shown  in  the  table  below. 


Table  3.  Variation  of  PVNT  noise 


Runs  conducted 

PVNT  noise  (meter) 

Run  1 

±  0 

Run  2 

±  1 

Run  3 

±  2 

Run  4 

±  3 

Run  5 

±  5 

1.  Results 

The  following  four  plots  show  results  obtained  for  both  the  general  and  road 
following  asynchronous  filters  for  the  rms  errors  obtained  for  the  target’s  velocity  and 
positions. 


Plot  of  velocity  rms  error  vs  PVNT  noise  (K1  =  0.5,  K2  =  0.5) 
(General  asynchronous  filter) 


PVNT  noise  (in) 


□  rms  error 


Figure  20.  Target  velocity  rms  errors  vs  PVNT  noise  (general  asynchronous  filter) 
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Figure  21. 


Figure  22. 


Plot  of  position  rms  error  vs  PVNT  noise  (K1  =  0.5,  K2  =  0.5) 
(General  asynchronous  filter) 
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Target  position  rms  errors  vs  PVNT  noise  (general  asynchronous  filter) 


Plot  of  velocity  rms  error  vs  PVNT  noise  (K1  =  0.5,  K2  =  0.5) 
(Road  following  asynchronous  filter) 
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Target  velocity  rms  errors  vs  PVNT  noise  (road  following  asynchronous 

filter) 
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Figure  23. 


Plot  of  position  rms  error  vs  PVNT  noise  (K1  =  0.5,  K2=  0.5) 
(Road  following  asynchronous  filter) 
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2.  Analysis 

For  the  general  asynchronous  filter,  the  increase  in  PVNT  noise  value  caused  an 
increase  in  the  rms  error  for  both  the  velocity  and  position  estimation.  However,  the 
magnitude  of  increase  was  not  significant.  The  trend  for  the  road  following 
asynchronous  filter  was  similar  and  the  increase  was  smaller  than  the  general 
asynchronous  filter.  The  accuracy  of  the  PVNT  position  update  (within  +/-  1  to  5  m)  was 
much  smaller  than  the  variation  in  the  x  and  y  distance  traveled  by  the  target  on  the 
simulated  road  during  simulation.  As  such,  the  filter  was  able  to  re-initialize  itself  to  a 
fairly  accurate  position  provided  by  PVNT.  The  road  following  asynchronous  filter  was 
able  to  provide  a  more  accurate  prediction  of  the  position  of  the  target  and  used  it  to  re¬ 
initialize  the  filter.  Thus,  its  rms  error  for  both  velocity  and  position  were  almost 
constant  for  PVNT  noise  up  to  3  meters. 

D.  GENERAL  ASYNCHRONOUS  FILTER  PERFORMANCE 

The  general  asynchronous  filter  was  run  with  the  following  parameters:  K1  =  K2 
=  0.5,  PVNT  delay  =  random  up  to  1  second,  PVNT  noise  =  +/-  3  meters.  The  plots  for 
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the  true  and  estimated  velocity  and  position  were  plotted  below.  The  rms  errors  were 
also  plotted. 


Figure  24.  Actual  vs  Estimated  target  position  (general  asynchronous  filter) 
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Figure  25.  Errors  in  x-direction  position  (general  asynchronous  filter) 
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Plot  of  erroi  s  in  tar  get  position  <y  position) 

(K1  =  K2  =  0.5.  PVMT  delay  =  random  up  to  1  sec.  PVIIT  noise  =  +/-  3  m> 


— Py  errors 

Figure  26.  Errors  in  y-direction  position  (general  asynchronous  filter) 


From  the  position  plots  above,  it  can  be  seen  that  the  main  errors  occurred  at  the 
beginning  of  the  road  and  toward  the  end  of  the  road.  In  these  two  sections  of  the  road, 
the  change  in  gradients  was  the  greatest.  The  general  asynchronous  filter,  without  the 
knowledge  of  the  road  profile,  could  only  rely  on  the  last  PVNT  position  update  to 
estimate  the  future  target’s  position.  As  such,  with  the  steeper  change  in  road  gradient, 
the  performance  of  the  filter  would  not  be  as  good  as  it  was  when  the  change  in  gradient 
of  the  road  was  more  gradual  (toward  the  center  part  of  the  road). 
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Plot  of  actual  vs  estimated  Vs  profile 
(K1  =  K2  =  0.5.  PVNT  delaj  =  random  up  to  1  sec.  PVNT 
noise  =  ♦/-  3  m) 


Figure  27. 
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Velocity  profile  in  the  x-direction  (general  asynchronous  filter) 
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Figure  28.  Error  in  the  x-direction  velocity  (general  asynchronous  filter) 
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Figure  29. 


Figure  30. 


Plot  of  actual  vs  estimated  Vj  profile 
(K1  =  K2  =  0.5.  PVNT  delaj  =  random  up  to  1  sec.  PVNT 
noise  =  •!-  3  m) 
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Velocity  profile  in  the  y-direction  (general  asynchronous  filter) 


Plot  of  errors  in  Vy  profile 
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noise  =  +/-  3  m> 
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Error  in  the  y-direction  velocity  (general  asynchronous  filter) 
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From  the  velocity  plots  above,  the  major  velocity  errors  occurred  when  the 
change  in  gradient  was  the  highest.  The  prediction  of  the  target’s  velocity  was  similar  to 
its  position  estimation  and  the  errors  generated  were  also  similar  when  there  was  a  large 
change  in  gradient  of  the  profiles. 

E.  ROAD  FOLLOWING  ASYNCHRONOUS  FILTER  PERFORMANCE 

The  road  following  asynchronous  filter  was  run  with  the  following  parameters: 
K1  =  K2  =  0.5,  PVNT  delay  =  random  up  to  1  second,  PVNT  noise  =  +/-  3  meters.  The 
plots  for  the  true  and  estimated  velocity  and  position  were  plotted  below.  The  rms  errors 
were  also  plotted. 


Figure  3 1 .  Actual  vs  Estimated  target  position  (road  following  asynchronous  filter) 
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Figure  32. 


Figure  33. 


Plot  of  errors  in  target  position  (x  position) 

(K1  =  K2  =  0.5,  PVIIT  delay  =  random  lip  to  1  sec.  PVIIT  noise  =  +/-  3 
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Errors  in  x-direction  position  (road  following  asynchronous  filter) 


Plot  of  errors  in  target  position  lx  position) 

|K1  =  K2  =  0.5,  PVIIT  delay  =  random  up  to  1  sec.  PVIIT  noise  =  +/-  3  m) 
[Expanded  view] 
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Expanded  plot  for  errors  in  x-direction  position  (road  following  asynchronous 

filter) 
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Figure  34. 


Figure  35. 


Plot  of  errors  in  target  position  (y  position! 

<K1  =  K2  =  0.5,  PVIIT  delay  =  random  up  to  1  sec.  PVIJT  noise  =  +/-  3  ml 
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Errors  in  y-direction  position  (road  following  asynchronous  filter) 

Plot  of  errors  in  target  position  (y  position! 

(K1  =  K2  =  0.5,  PVIIT  delay  =  random  up  to  1  sec,  PVIIT  noise  =  +/-  3  nr! 

[Expanded  plot] 
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Based  on  the  parameters  specified  for  the  simulation,  the  road  following 
asynchronous  filter  was  able  to  provide  very  accurate  position  estimation.  Both  the  x  and 
y  direction  errors  were  close  to  zero.  This  road  following  asynchronous  filter  showed  a 
vast  improvement  as  compared  to  the  general  asynchronous  filter.  The  knowledge  of  the 
road  profile  allowed  the  optimization  routine  to  further  reduce  the  error  that  the  PVNT 
position  estimate  provided.  The  filter  was  able  to  integrate  along  the  road  provided  and 
gave  very  accurate  target  position  estimation. 


Plot  of  actual  vs  estimated  Vi  profile  (road  following) 
(K1  =  K2  =  0.5.  PVNT  delag  =  random  delag  up  to  1  sec. 
PVNT  noise  =  .1-  3  m) 


— *  —  Vx  true  — ■ —  Vx  est 


Figure  36.  Velocity  profile  in  the  x-direction  (road  following  asynchronous  filter) 
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Plot  of  errors  in  Vx  profile 

|K1  =  K2  =  0.5.  PVIIT  delay  =  random  delay  up  to  1  sec, 
PVIIT  noise  =  +/-  3  m) 


Time  is) 
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Figure  37.  Error  in  the  x-direction  velocity  (road  following  asynchronous  filter) 


Plot  of  actual  vs  estimated  Vj  profile 
(K1  =  K2  =  0.5.  PVNT  delaj  =  random  delaj  up  to  1  sec. 
PVNT  noise  =  •!-  3  m) 


— •  —  Vyjrue  — - —  Vy_est 


Figure  38.  Velocity  profile  in  the  y-direction  (road  following  asynchronous  filter) 
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Plot  of  errors  in  Vy  profile 

|K1  =  K 2  =  0.5,  PVIIT  delay  =  i  andom  delay  up  to  1  sec, 
PVIIT  noise  =  +/-  3  m) 


Time  is) 


— ♦ —  Vy  errors 

Figure  39.  Error  in  the  y-direction  velocity  (road  following  asynchronous  filter) 

The  target’s  velocity  estimation  was  very  accurate  using  the  road  following 
asynchronous  filter.  The  filter  was  able  to  use  the  derivative  of  the  path  length  (i.e., 
speed)  to  estimate  the  target’s  velocity.  Due  to  the  accuracy  provided  by  the 
minimization  routine  in  obtaining  the  path  length,  its  derivative  yields  accurate  velocity 
estimation. 
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VII.  CONCLUSION  AND  RECOMMENDATION 


A.  CONCLUSION 

The  task  of  designing  an  asynchronous  filter  was  achieved  in  this  thesis.  The 
asynchronous  fdter  was  able  to  use  the  delayed  PVNT  target  position  updates  that  arrived 
about  1  to  10  seconds  later  to  refine  the  target’s  motion  estimation.  This  simple  filter  has 
shown  its  capability  to  estimate  target  motion  in  simulation.  Furthermore,  the  general 
asynchronous  filter  was  modified  to  allow  the  incorporation  of  a  road  model.  This 
allowed  a  better  prediction  of  target  motion  as  the  target’s  motion  is  expected  to  be  along 
the  road  that  it  is  traveling  on.  In  simulation,  it  was  shown  that  this  modified  filter  could 
estimate  the  target’s  velocity  and  position  very  accurately. 


B.  RECOMMENDATION 

The  new  asynchronous  filter  worked  well  in  simulation.  In  the  future,  this  filter 
could  be  incorporated  in  the  hardware  and  be  bench-tested.  Further  test  in  actual  SUAV 
flight  could  be  conducted  once  bench  testing  has  shown  promising  results. 

The  asynchronous  filter  could  also  be  combined  with  the  current  non-linear  filter 
so  that  the  two  complement  each  other  during  target  motion  estimation.  The  advantage 
of  the  asynchronous  filter  is  in  its  ability  to  use  the  delayed  but  more  accurate  PVNT 
update  to  provide  a  better  target  velocity  and  position  estimation  at  current  time.  This 
information  could  be  used  to  re-initialize  the  nonlinear  filter  to  enhance  its  performance 
such  that  the  current  10  -  20  m  accuracy  could  be  reduced. 
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